#include <Servo.h>
#include <robotLac.h>

robotLac robot(28,1);
Distance_Sensor dSensor(31, 29);
int llego=0;

void setup(){
  robot.begin();
  robot.detener();
  dSensor.begin();
}

void loop (){  
  if((dSensor.get_distance()>0.20)&&(llego==0)){
    robot.avanzar();
    delay(100);
    }
  else if(dSensor.get_distance()>0.20){
    llego=1;
    robot.antihorario();
    delay(100);
  }
  else{
    llego=1;
    delay(200);
    robot.derecha();
    delay(100);
    
    if(dSensor.get_distance()<0.10){
    robot.horario();
    delay(300);
  }
  }  
}

